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Abstract: The paper demonstrates a following robot with omni-directional wheels, which 
is able to take action to avoid obstacles. The robot design is based on both fuzzy and 
extension theory. Fuzzy theory was applied to tune the PMW signal of the motor 
revolution, and correct path deviation issues encountered when the robot is moving. 
Extension theory was used to build a robot obstacle-avoidance model. Various mobile 
models were developed to handle different types of obstacles. The ultrasonic distance 
sensors mounted on the robot were used to estimate the distance to obstacles. If an obstacle 
is encountered, the correlation function is evaluated and the robot avoids the obstacle 
autonomously using the most appropriate mode. The effectiveness of the proposed 
approach was verified through several tracking experiments, which demonstrates the 
feasibility of a fuzzy path tracker as well as the extensible collision avoidance system. 

Keywords: extension theory; fuzzy theory; obstacle-avoidance; omni-directional mobile 
robot; ultrasonic sensors 



1. Introduction 

The development of omni-directional wheel systems has made it possible to build robots that can 
move laterally without needing to rotate. Several researchers have employed omni-directional wheels 
in their robot designs. A dynamic model and a nonlinear mobile issue are explored in [1-3], where an 
omni-directional vehicle is equipped with up to three motor sets. Using a Field Programmable Gate 
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Array (FPGA) as the control core, a multi-robot [4] was developed by integrating a robot arm into an 
omni-directional mobile robot, enabling better interaction between the robot and users. 

Many factors can cause path deviation in a robot, such as variation in motor mechanical tolerances, 
power output, the weight borne by wheels, and even the ground surface; thus, path deviation is 
unavoidable. This study employs a compensation approach based on a motor encoder using fuzzy logic 
to resolve the problem of straight path deviation [5,6]. Motor revolutions are evaluated based on the 
feedback pulses that are dispatched from the motor encoder at specific intervals interval; in order to tune 
the value of the Pulse Width Modulation (PWM), and thus, the specified motor revolutions are set. 

Several approaches have been employed to avoid obstacles. These include lasers and infrared [7,8], 
vision systems [9,10], and wall following using ultrasonic sensors [1 1-13]. Extension theory was proposed 
in 1983 to solve contradictions and incompatibility problems. It consists of two parts — matter-element 
model and extended set theory — and can be applied to classification or fault diagnosis [14]. Fuzzy 
theory, proposed by L. A. Zadeh in 1965, uses fuzzy rules and fuzzy inference to replace complicated 
equations. It's widely used in robot control [15]. In this paper, the obstacle-avoidance system is 
modeled as multi-dimensional obstacle-avoidance matter-elements, where the names of the extension 
matter-elements are the same as the number of obstacle-avoidance modes. The proposed approach 
utilizes ultrasound to complete the task and to implement the matter-element extension model. In this 
way, obstacles can be modeled and an optimal tracking approach is implemented. 

This paper is organized as follows: Section 2 describes the hardware configuration of the robots. 
Section 3 introduces the omni-directional wheeled mobile robot designed using fuzzy logic theory. 
Section 4 presents an extension theory based on an obstacle avoidance system. Section 5 gives a 
discussion of experimental results and Section 6 presents our conclusions. 

2. Hardware Design 

The omni-directional mobile autonomous following robot control system is composed of an 
industrial motherboard (SBC86850) along with a Peripheral Interface Controller (PIC) micro controller 
(DSPIC30F6010A) that serves as the control core and commands the peripheral hardware. The 
peripheral hardware itself consists of a motor (3863A024C), a motor driver (MD03), a motor encoder 
(HEDS-5500 A12), an ultrasonic distance sensor (the PING™ Ultrasonic Range Finder), and a 
Bluetooth controller. Figure 1 shows a diagram of the omni-directional mobile robot. Figure 2 shows 
the three parts of the robot tracking system, namely the user interface, a workstation, and the robots. 

There are two user modes available: manual and autonomous tracking. In manual mode, we use a 
Wii controller to control the robot's direction of movement and speed. In the autonomous tracking 
mode, the operator is provided with an infrared emitter module, as shown in Figure 3, which emits 
infrared signals to enable the robot to track and follow the operator autonomously. 

The camera is connected to the workstation and has an infrared filter so that an infrared image is 
displayed on the screen. The camera is a Logitech Quick Cam Pro 5000, which captures an infrared 
light source handled by the operator. The industrial motherboard comprises the follower-tracking 
component of the system, and analyzes the infrared data, which is converted to physical coordinates 
giving the relative position of the user and the robot. This data is then used to control the direction and 
speed of the robot. 
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Figure 3. The IR source carried by the user. 
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The robot employs two PIC micro controller boards, with one serving as a signal capture board and 
the other as a motor control board. This decentralized setup can improve the processing efficiency of 
the PIC micro controller. The signal capture board receives the command issued by the workstation 
and the Wii controller signal. The motor control board handles the motor control function, and receives 
information from the ultrasonic distance sensor. 

3. An Omni-Motion Control System Based Upon Fuzzy Theory 

The robot implemented in this research is capable of directed translation movement along the x and 
y axis, and rotational movement along the z axis. All signals dispatched from the motor encoders are 
translated into the PWM format and are used to calculate the motor revolution. These are then 
compensated by applying fuzzy logic theory to correct the path deviation. The flowchart of the 
proposed omni-motion control system is shown in Figure 4. 

Figure 4. Proposed system flowchart. 
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3.1. Building a Kinematic Equation 

Figure 5 shows the three motors positioned at a distance R from the origin, {i.e., the base center), 
and placed at equal angles to each other, where the angle between the wheel axes is 120 degrees. The 
angles 6i, 62, and 63 are the angles of the wheels measured relative to the x y plane, (j) is the rotational 
angle of the robot; Vi, V2, and V3 represent the three wheel speeds, and Vm is the target movement 
direction. The experimental setup of the robot is shown in Figure 6. 
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Figure 5. Configuration of the omni-directional mobile robot. 




Figure 6. The experimental setup of the omni-directional mobile robot. 




Vm is the intended movement direction of the robot and can be represented as Vm = {Vmx, Vmy), form 
its X and y components, (j) is the robot's rotate angular velocity. The equations of motion Vu V2, V3 are 
as expressed as: 
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A movement rule base can be designed from the kinematic equation. 
3.2. Fuzzy Controller Design from Motor Encoders 



Robots in real environments are easily affected by several factors. For example, the output power of 
the three groups of motors may be uneven, ground friction may vary, or the weight balance may be 
uneven. All these factors can cause the path of the robot to deviate. 



Sensors 2012, 12 



13952 



As shown in Figure 7, the output the output Uk is the sum of Uk-i and Aw. h.u is the motor revolution 
error and error difference, represents the amount of PWM adjustment needed. The inputs to the fuzzy 
controller are e and de, where e is motor speed error and de is error variation. Therefore, the straight 
path deviation is compensated through an invariant motor revolution. 

Figure 7. The control system block diagram. 
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Figure 8 shows membership functions of the input variable e and de and the output Ai^, where a 
triangle function is used as the single membership function. The fuzzy set is composed of the 
following values: negative big (NB), negative medium (NM), negative small (NS), zero (ZO), positive 
small (PS), positive medium (PM) and positive big (PB). 

Figure 8. Input and output membership functions. 




Q. 

0.8 

0) 
SI 

E 0.6 
£ 

o 0.4 

<D 
<D 

0)0.2 

0) 

Q 



NB 


Zt) 


PB 


1 1 1 1 1 



-30 



-20 



-10 



0 

de 



10 



20 



30 




NSZOPS PlVi PB" 





0 5 10 

A U 



Sensors 2012, 12 



13953 



By developing rules of thumb based upon several measurements, premise and consequence are 
deduced and the tuned ranges of membership functions are determined accordingly. The rule base 
consisting of 21 rules for motor encoder compensation is given in Table 1, and an example is 
illustrated by: 

If e is NM and de is ZO, then b^u is PM. (2) 
Table 1. A motor encoder compensation rule table. 
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It is assumed that if the motor revolution error e is NM, the revolution error difference de is ZO, 
and the PWM adjustment (An) is PM. This situation is assumed to represent a realistic motor 
revolution value that is less than the expected value, which has an error within the tolerance range. 
Therefore, the motor PWM is increased by the value of PM. 

We perform a fuzzy interference using a minimum inference engine. The controller output 
represents the center of gravity defuzzification and is determined by the algorithm. The input and 
output relationship curve of the fuzzy controller is shown in Figure 9. 



Figure 9. The fuzzy input and output relationship graph. 




We set motor PWM to divide into 128 equal parts, i.e., 0-121 . As shown in Figure 10(a), we set the 
initial values of the PWM driving the three motors to 80. A straight path deviation is observed because 
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of the non-uniform feedback signal. Figure 10(b) shows the activation of the fuzzy controller at 15 ms 
to equalize the three motor revolutions. However, it should be noted that the three motor sets 
experience different levels of PWM due to variation in the load carried by the robot, motor efficiency, 
and other factors. 

Figure 10. Experimental results of the motor revolution using fuzzy theory, (a) PWM 
tuning curves and (b) encoder feedback curves for the three motor sets. 
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4. An Extensible Obstacle-Avoidance System Design 

Extension theory is used to describe the inference process of obstacle-avoidance, which allows us to 
transform a complex problem in the real world into one expressed through matter-elements. As shown 
in Figure 11 and in Equation (3), nine sets of ultrasonic distance sensors are installed on the left, 
front-left, front-right, and right sides. An appropriate movement path can be selected by applying 
extension theory after converting the analogue distance signal into a digital value: 



Left side distance 
Left front distance 
Right front distance 
Right side distance 



= Ultrasonic 1 n Ultrasonic 2 

= Ultrasonic 3 n Ultrasonic 4 n Ultrasonic 5 

= Ultrasonic 6 n Ultrasonic 7 

= Ultrasonic 8 n Ultrasonic 9 



(3) 
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Figure 11. Ultrasonic distance sensors shown on the robot periphery. 
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4.1. Matter-Element Extension Set 

In this section we quantify the extension set characteristics mathematically. The set with name 
(Name, N), characteristic (Characteristic, C), and with characteristic value (Value, V) is used to 
describe the three basic elements. 

In this work, the obstacle-avoidance system is modeled as multi-dimensional obstacle-avoidance 
matter-elements, where the names of the extension matter-elements are the same as the number of 
obstacle-avoidance modes. The ultrasonic distance sensors are defined by four characteristics. Various 
motion approaches based on the principle of the multi-dimensional extension matter-element model, 
are expressed in Equation (4). These are associated with various motion strategies: 

[^ui 'Q.-u ^uijAjij >] ,/l = 1,2,--- J J 

[^2,/2 'Q,/2J ^2,/2J'^2,/2J >] , /2 = 1,2, • • • ,6 J 



Ka = 



2J2 



1,2,3,4 
1,2,3,4 



(4) 



R 



-3,i3 



XiXj 



,/3 = l,2,---,6 ,7=1,2,3,4 



Ri.il, Ri.ii, Rs.is represent various matter-element models, N]j], N2,i2, Nsjs are the names of various 
obstacle modes, and C]j}, €2,12, C3J3 are the distances to the obstacles in each aspect. The terms <a]j]j, 
bi,iij>, <a2,i2,j, b2,i2,j>, <'^3,i3,j, b3,i3j> are the scopes of the classical domains defined in various aspects. 
This work comprises three sets of models, representing various motion approaches. Strategies are built to 
avoid obstacles in various aspect directions. There are up to seven motion strategies specified for the 
forward motion, and six for the left forward and the right forward, as show in Tables 2 to 4. 



Table 2. Rule table for forward motion in the extension-element model. 



Number Obstacle Location 



Extension Element Model 



Approach 



No obstacle 



R 



11 



11 



,C^^^ ,< 15,200 > 
,C^j2 ,< 15,200 > 



113 



,< 15,200 > 



,Cjj4 ,< 15,200 > 



Move forward 
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Table 2. Cont. 



Number Obstacle Location 



Extension Element Model 



Approach 



Left forward 



Right forward 



forward 



forward, Left 



All 



^12" 



Left ft)rward, Right ^ 



14 



Left fijrward, Right 
ft)rward, Right 



15 



16 



N. 



12 



^13- 



13 



14 



15 



Left forward, Right _ 



16 



^7 = 



N. 



121 



122 
123 
124 



131 



'^1 



132 
133 



134 



,C 
,C 
,C 

,c 



,c 



141 
142 
143 
144 

151 
152 
153 



154 



161 



162 



163 



17 



■^164 



,C 



171 
172 
173 
174 



,< 15,200 > 
,<0,15 > 
,< 15,200 > 
,< 15,200 > 

,< 15,200 >" 
,< 15,200 > 
,<0,15 > 
,< 15,200 > 

,< 15,200 > 

,<0,15> 

,<0,15> 

,< 15,200 > 

,< 15,200 > 
,<0,15 > 
,<0,15 > 
,<0,15 > 

,<0,15> 
,<0,15> 
,<0,15 > 
,< 15,200 > 

,<0,15 > 
,<0,15 > 
,<0,15 > 
,<0,15 > 



Move right 



Move left 



Move left or right 



move left 



Move right 



Move backward 



Table 3. Rule table for left forward motion in the extension-element model. 



Number Obstacle Location 



Extension Element Model 



Approacli 



No obstacle 



Left 



^21 = 



N, 



21 



■^22 = 



N. 



22 



211 



212 
213 



214 



221 
222 
223 
224 



,< 15,200 > 
,< 15,200 > 
,< 15,200 > 
,< 15,200 > 

,<0,15> 
,< 15,200 > 
,< 15,200 > 
,< 15,200 > 



Move left forward 



Move forward 
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Table 3. Cont. 



Number Obstacle Location 



Extension Element Model 



Approach 



3 Left, Left forward 



Left, 

4 

Right forward 
Left, 

5 Left forward. 

Right forward 



6 Upper left comer 



^23 - 



N. 



23 



^24 = 



N 



24 



^25 = 



N. 



25 



•^26 = 



26 



,C, 
,C 
,C 
,C 



231 
232 
233 



234 



,C. 

,c 



241 
242 
243 
244 

251 
252 
253 



254 



261 
262 
263 
264 



,<0,15 > 
,<0,15 > 
< 15,200 > 
,< 15,200 > 

,<0,15> 
,< 15,200 > 
,<0,15 > 
,< 15,200 > 

,<0,15> 
,<0,15> 
,<0,15> 
,< 15,200 > 

,< 15,200 > 
,<0,15> 
,< 15,200 > 
,< 15,200 > 



Move right 



Move right 



Move right 



Move right fonvard 



Table 4. Rule table for right forward motion in the extension-element model. 



Number Obstacle Location 



Extension Element Model 



Approach 



No obstacle 



Right 



Left fi)rward, 
Right 

Right forward. 
Right 



^31- 



N. 



31 



^32 - 



32 



■^33 = 



33 



■^34 = 



34 



,C 
,C. 
,C 



311 
312 
313 



314 



,c 
,c 
,c 

,c 
,c 

,c. 
,c. 



321 



322 
323 
324 

331 
332 
333 



334 



,C 
,C 



341 
342 
343 
344 



,< 15,200 > 
,< 15,200 > 
,< 15,200 > 
,< 15,200 > 

,< 15,200 > 
,< 15,200 > 
,< 15,200 > 
,<0,15 > 

,< 15,200 >" 
,<0,15> 
< 15,200 > 
,<0,15> 

,< 15,200 > 
,< 15,200 > 
,<0,15 > 
,<0,15> 



Move right forward 



Move forward 



Move left 



Move left 



Sensors 2012, 12 



13958 



Table 4. Cont. 



Number Obstacle Location 



Extension Element Model 



Approach 



Left forward, 

5 Right forward, 

Right 

6 Upper right comer 



35 



351 



,C 



352 
353 



354 



^36- 



36 



361 



362 
363 
364 



,< 15,200 > 
,<0,15> 
,<0,15> 
,<0,15> 

,< 15,200 > 
,< 15,200 > 
,<0,15 > 
,< 15,200 > 



Move left 



Move left forward 



4.2. Correlation Function 

In Figure 12 a classical domain and a neighborhood domain are defined on the interval Xq = <a, b> 
and X = <c, d> respectively. The neighborhood domain is defined as X = <0, 200>, and Xo X, 
without any common end points. The primary correlation function can be defined as: 

p(x,Xo) 



K(x). 



(5) 



D(x,Xo,X) 

where D(x, Xq, X) is a point position value, and the relationship between a point and two different 
ranges is defined as: 



D(x,Xo,X) = 



p(x,X)-p(x,X^) .x^X^ 



-1 



,xeX 



(6) 



The relationship between x andXo is defined as: 



where the point x is related to the range X as: 

p(x, X)= X 



a -\-b 



c + d 



-(b-a) 



-id-c) 



(7) 



(8) 



Figure 12. An extension correlation function. 

K(x) 
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4.3. Evaluation Method and the Best Strategy of Obstacle Avoidance 

In Figure 13 the procedure for an optimal evaluation strategy is described in order to find the best 
strategy of obstacle-avoidance. The optimal obstacle-avoidance depends on the obtained maximum 
correlation degree by means of the following procedure: 

1. We first define evaluation conditions. The correlation set Km, K2J2, K3J3, (i.e., the 
obstacle-avoidance strategies) made by three mobile modes and four sets of distance 
sensors mounted in various angles, are expressed as: 

X,/i = {Krjij } a = 1,2, ... ,7 , 7 = 1,2,3,4 

^K,,,={K,.,J /2 = 1,2,...,6 ,7=1,2,3,4 (9) 
A^3={^3.3,,} ^'3 = 1,2,. ..,6 ,7=1,2,3,4 

Figure 13. The procedure for determining an optimal evaluation strategy. 



Assign the evaluation 
conditions 

i 

Set the weighting 

i 

Find the correlation 
function 

i 

Determine the optimal 
evaluation solution 



2. The weightings Wmj, W2,i2,j, Wsjsj of four sets of distance sensors to detect obstacles 
are assigned the same value of 1/4. The correlation between each distance sensed is 
expressed as: 

7=1 

4 

' K2J2 = Z ^2j2jK2j2j . i2 = 1,2,.. .,6 (10) 

7=1 

4 

^3,/3 = S ^3,/3J^3,/3J ' i3 = 1,2,..., 6 

7=1 

3. The maximum degree of correlation in the individual mobile modes is extracted for the 
optimal obstacle-avoidance strategy, and can be found by comparing the optimal 
degree of evaluation between Kjjj, K2J2 and K3J3, as: 
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i\=\,2,---l 



(11) 



K 



3™x = .max .3 

z3=l,2,---6 



4. The choice of obstacle-avoidance mode for a robot is evaluated as the degree of 
correlation within a set of multi-dimensional obstacle-avoidance matter-element 
modes. This is then translated into the optimal strategy to avoid obstacles. 

In Equation (12) the directions representing the mobile mode are given. If the direction is equal to 
1, it denotes forward motion, 2 represents front forward, and any other value represents a forward-right 
direction. The obstacle direction representing the optimal obstacle-avoidance strategy is sent to the 
robot, where Kijnax represents the optimal strategy for forward motion, K2_max for forward-left 
motion, and Ksjnax for forward-right: 

if {direction == 1) 

obstacle _ direction = K\ _ max; 
else if {direction = 2) 

obstacle _ direction = K2 _ max; 

else 

obstacle direction = K3 max; 



(12) 



5. Experimental Results and Analysis 

The interface design of the autonomous mobile robot controller is shown in Figure 14. A data link 
interface to the robot through an RS232 serial transmission, carries the control signal sent from the 
workstation to the micro controller. This is usually in manual mode. An operational test for 
obstacle-avoidance by the omni-directional robot was conducted, as shown in Figure 15 and Figure 16. 



Figure 14. The data link control interface. 
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Figure 15. A set of omni-directional mobile experiments, (a) Forward, (b) turn right, (c) 
turn left, and (d) rotate back. 




The omni-directional mobile robot was seen to exhibit high mobility in a complex environment. We 
also tested the obstacle avoidance capability. In order to correct the path deviation, the aspect angle of 
movement, and the target speed are transmitted to the three motor sets driven by a fuzzy logic 
controller to provide a compensation approach for the motor encoder. The robot was able to avoid all 
obstacles, proving the effectiveness of the proposed system. Thus, the feasibility and the effectiveness 
of the robot were validated. 
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Figure 16. A set of obstacle-avoidance experiments, (a-d) Actual experimental pictures of 
the robot pass the first obstacle and (e-h) actual experimental pictures of the robot pass the 
second obstacle. 




(a) {h) (c) {A) 




(e) (f) (g) (h) 

6. Conclusions 

In this study, omni-directional wheels were used to develop a robot capable of omni -directional 
movement. The robot offers improved mobility as it utilizes lateral movement over rotational 
movement by utilizing the omni-directional wheel design. The robot was tested in various mobile 
modes in a complex environment, and was able to compensate for path deviations through motor 
encoder compensation based on fuzzy logic theory. The robot was also able to avoid all obstacles in its 
path autonomously by employing ultrasonic distance sensors with an obstacle-avoidance algorithm. 
The aim of implementing omni-directional motion control for a three-wheeled autonomous robot was 
achieved. The robot offers high mobility, motion path correction, and an obstacle avoidance capability. 
This robot system is suitable for libraries, supermarkets, airports, hospitals and similar scenarios. 
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